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(§4) Procede et disposttrf pour la detection et la localisation d'obstacles dans I'envlronnement d'un vehicul 



\S7) L' invention concern e un procede de detection et de lo- 
calisation d'obstacles dans I'environnement d'un vehicule. 
A cat effet, il comprend les etapes consistant a emettre des 
signaux en direction dudit environnement a partir d'une ptu- 
ralite de radars (2) disposes sur le vehicule, a deduire des 
signaux recus en echo les probability d'occupation par un 
obstacle d'un ensemble de cellules elementaires (9) dudit 
environnement, et a fusionner les probabilites relatives a 
chacune desdites cellules. 
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A 

Proc6de t dispositif pour la detection et la localisation 
d'obstacles dans Penvironnement d'un v§hicule 

La presente invention concerne un procede et un dispositif pour la detection et 
la localisation d'obstacles situes dans I'environnement d'un vehicule arrete ou 
en mouvement. 

Une fonction importante de la robotique mobile concerne la detection des 
objets ou obstacles situes au devant ou sur le cote du vehicule porteur, dans la 
mesure ou ceux-ci peuvent entraver son mouvement et doivent etre 
contournes, ou necessitent son arret complet par souci de securite ou, au 
contraire, sont suffisamment distants ou dans une direction telle que le 
vehicule peut continuer son chemin sans ecart. 

Un aspect secondare de cette detection consiste a exploiter une connaissance 
a priori du positionnement (absolu) de I'objet detecte par rapport a une carte ou 
un site plus vaste, pour qu'en detectant cet objet et en mesurant ses 
coordonnees (site et distance) on puisse en retirer une information sur la 
position absolue du vehicule lui-meme. 

Un moyen commode pour detecter des objets situes dans la peripherie d'un 
vehicule et permettant d'en mesurer les coordonnees consiste a utiliser des 
capteurs a ultra-sons. 

Selon cette technologie bien eprouvee, une onde acoustique est emise 
periodiquement et. se trouvant reflechie par les objets constituant des 
obstacles a sa propagation, revient vers le capteur apres un temps de retard, 
lequel depend directement de la distance de I'objet ainsi detecte. 

Pour assurer la detection peripherique d'un vehicule, il convient de disposer un 
nombre suffisant de tels capteurs sur son pourtour en fonction de Tangle 
d'ouverture du capteur elementaire. Ce nombre est d'autant plus eleve que les 
capteurs auront un lobe de detection etroit. 

L'utilisation de ces capteurs fournit une information de distance par rapport a 
un obstacle, mais I'information d^rientation angulaire est d'autant moins bonne 
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que les capteurs sont a lobe large. En effet, dans la mesure ou un capteur voit 
un obstacle donne non pas en un point de I'espace mais de maniere ambigue 
en tous points situes a egale distance, si Ton associe plusieurs capteurs pour 
assurer la couverture du perimetre du vehicule, redetermination de la position 
5 angulaire des obstacles detectes peut etre excessivement grande. 

A contrario, une detection plus fine exige un nombre superieur de capteurs 
elementaires, a lobes plus etroits, ce qui accroTt le cout global de la detection. 

10 Un autre inconvenient de Tutilisation de capteurs a ultra-sons est leur tres 
grande sensibilite aux perturbations acoustiques exterieures, aux anomalies de 
reflexion sur certains obstacles, ainsi que la sensibilite au vent des ondes 
sonores, Techo pouvant meme etre souffle et ne jamais revenir a sa source. 

is La presente invention vise a pallier ces inconvenients. 

A cet effet, ('invention a tout d'abord pour objet un procede de detection et de 
localisation des obstacles situes dans renvironnement d'un vehicule, 
caracterise par le fait qu'il comprend les etapes consistant a emettre des 
20 signaux en direction dudit environnement a partir d'une pluralite de radars 
disposes sur le vehicule, a deduire des signaux regus en echo les probabilites 
d'occupation par un obstacle d'un ensemble de cellules elementaires dudit 
environnement, et a fusionner les probabilites relatives a chacune desdites 
cellules. 

25 

Des algorithmes de fusion d'informations sont deja connus dans la technique. 
Toutefois le fait de fusionner des probabilites d'occupation de cellules 
elementaires, ces probabilites etant elles-memes obtenues a partir de signaux 
radar, peut donner, avec la technique selon I'invention, des resultats tout a fait 
30 surprenants par leur precision, permettant meme la cartographie des obstacles 
detectes et rendant done possible leur evitement ainsi que la localisation du 
vehicule lui-meme, du fait de la grande qualite de la modelisation de 
Tenvironnement ainsi effectuee. 

35 Par ailleurs, contrairement aux capteurs a ultra-sons, les radars peuvent etre 
utilises en exteheur et par tout temps. 
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Enfin on a pu constater que I'invention permet meme d'utiliser des radars de 
performance individuelle relativement mediocre sans alterer les resultats de la 
modelisation globale. 

Dans un mode de realisation de I'invention, la fusion est effectuee sur les 
valeurs des probabilites fournies par une plurality de radars, et notamment 
deux radars. 



Dans ce cas, la fusion est effectuee de maniere spatiale de maniere a associer 
des donnees retournees simultanement par un sous-ensemble de radars ayant 
detecte un meme obstacle sous des angles differents. 

Dans un autre mode de realisation, la fusion est effectuee sur la valeur de la 
probabilite fournie par un radar et la valeur de la probabilite anterieurement 
connue pour la meme cellule. 

La fusion est dans ce cas effectuee de maniere temporelle, le meme obstacle 
etant vu successivement par un meme capteur qui aura avance en meme 
temps que le vehicule. Dans ce cas, I'operation de fusion est appliquee a la 
valeur deja affectee a la cellule. 

On peut deduire des signaux recus en echo une information de distance et une 
information angulaire sur les obstacles et determiner lesdites probabilites 
d'occupation a partir de ces informations. 

De preference on prevoit une etape de seuillage des resultats de la fusion de 
maniere a obtenir une carte depouillee des artefacts divers pouvant provenir 
de reflexion speculates ou multiples, des ondes radars emises. 

Selon un mode de realisation particuliere de I'invention, le signal emis par les 
radars est module en frequence, le signal recu en echo est melange a une 
fraction du signal emis pour, apres elimination de la frequence porteuse, former 
un signal de battement, et les impulsions de battement sont comptees pendant 
un intervalle predetermine pourfournir la distance d'un obstacle. 
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En variante, cette distance peut etre fournie par transformation cle Fourrier. 

Avantageusement, remission de chaque radar dure un temps limite et la 
logique de repetition peut meme etre codee en vue de ('identification de la 
5 source. 

L'invention a egalement pour objet un dispositif pour la modelisation de 
I'environnement d'un vehicule, caracterisee par le fait qu'il comprend une 
plural ite de radars montes sur le vehicule et une unite de traitement agencee 
10 pour fusionner les donnees fournies par les radars. 

Grace a Toperation de fusion, on peut sans inconvenient choisir des radars a 
lobe large, done de performance moyenne et de'eout peu eleve. 

is On observera que les radars de ce type, notamment les radars Doppler 
courants, sont generalement utilises en mesure de vitesse alors qu'ici, e'est la 
distance qui est mesuree a titre principal, la mesure de vitesse n'etant 
eventuellement utilisee qu'a titre accessoire. De surcroit, alors que les radars 
utilises en vue de mesures de distances sont generalement des radars 

20 fonctionnant en impulsions, on utilise ici de preference des radars a emission 
continue et fonctionnant en modulation de frequence. 

On decrira maintenant a titre d'exemple non limitatif un mode de realisation 
particulier de Tinvention, en reference aux dessins schematiques annexes dans 
25 lesquels : 

- la figure 1 est une vue schematique de dessus d'un vehicule muni des 
moyens de l'invention, 

30 - la figure 2 est un diagramme fonctionnel de ces moyens. 

- la figure 3 illustre les signaux emis par les radars, 

- la figure 4 represente la modelisation de Tenvironnement du vehicule, 

35 
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- la figure 5 illustre la fonction de repartition des probability d'occupation d'une 
cellule par un obstacle en fonction de la distance au foyer d'une antenne et 

- la figure 6 illustre la fonction de repartition des probability d'occupation de 
cette cellule en fonction de I'ecart angulaire entre sa direction et I'axe de 
I'antenne. 



La figure 1 represente un vehicule automatique muni d'une plate-forme 1 sur 
laquelle sont montes une plurality de radars 2, par exemple une vingtaine. Les 
radars 2 sont ici des radars a lobe large, c'est-a-dire d'angle d'ouverture 20 
typiquement compris entre 15° et et 120°. On rappelle qu'un angle 29 important 
est recherche pour obtenir une bonne couverture peripherique autour du 
vehicule avec un nombre de capteurs aussi reduit que possible. 

Les radars 2 sont ici des radars FMCW a modulation de frequence et a 
emission continue ou par fenetre temporelle. 

Les radars 2 sont places a la peripherie du vehicule de maniere a obtenir une 
vision aussi complete que desiree de son environnement. La finesse de la 
couverture de detection et de la moderation en general, depend directement 
du nombre de radars utilises dont les lobes individuels peuvent se rejoindre 
arbitrairement comme cela est repesente vers I'avant (fleche 3) et le cote du 
vehicule. 

On voit sur la figure 2 trois des antennes radars 2a, 2b et 2c. Chacune de ces 
antennes est reliee par I'intermediaire d'un circuit d'inteface 4a, 4b, 4c 
respectivement, a une unite 5 susceptible d'elaborer les signaux de 
declenchement Sa, Sb et Sc respectivement des radars. En variante, les 
signaux de declenchement peuvent etre communs a tous les radars. 

Les signaux Sa, Sb. Sc sont modules en frequence comme represente a la 
figure 3. Une frequence porteuse Fp est modulee par une onde en dent de scie 
de frequence Af. Cette generation de frequence peut etre assuree au niveau de 
I'unite 5 par une diode oscillatrice GUNN. 
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Optionnellement, pour chaque signal Sa, Sb t Sc, remission modulee dure un 
temps limite D. On facilite ainsi la differenciation des signaux regus ainsi que 
I'extraction des informations recherchees. Par ailleurs, en codant la logique de 
repetition des emissions, c'est-a-dire la duree T sur la figure 3, par exemple 
selon un modele pseudo-aleatoire, il est possible de personnaliser chacune 
des emissions. On peut ainsi en particulier faire evoluer plusieurs vehicules 
dans le meme environnement. 

Le signal re?u en retour par chaque antenne 2a, 2b, 2c est traite dans une 
unite de traitement analogique 6a ? 6b, 6c respectivement. 

Le signal re?u est dephase par rapport au signal emis. Par melange dans 
Tunite 6 correspondante avec une fraction du signal emis, apres elimination de 
la frequence porteuse, un signal de battement a une frequence type de I'ordre 
de 1 kHz est obtenu. 

Le signal est tout d'abord filtre pour eliminer les hautes frequences, 
correspondant aux obstacles les plus eloignes. On ne retient ainsi que le signal 
retrodiffuse par le premier obstacle rencontre, qui est ensuite traite par 
transformee de Fourrier. 

Par ailleurs, la comparaison de la frequence de Tonde porteuse retrodiffusee et 
de celle de I'onde porteuse du signal emis donne la frequence Doppler F<j qui 
est proportionnelle a la vitesse de rapprochement ou d'eloignement du vehicule 
de Tobstacle detecte, selon la relation : 

v = 1/2 XF d 

ou X = c/F (vitesse de propagation/frequence d'emission) 

L'information de vitesse n'est pas necessaire a la mise en oeuvre de 
Tinvention. Sa disponibilite constitue neanmoins un avantage dans les 
applications. 

Les informations de distance et vitesse numerisees sont fournies par les unites 
de traitement analogiques 6a, 6b, 6c au processeur numerique 7. 
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Le processeur 7 est constitue pour I'essentiel d'une unite de calcul susceptible 
d'acceder a une memoire 8. 

A chaque element de la memoire 8 est associee une cellule elementaire 9 de 
I'environnement du vehicule. Le contenu de chacun de ses elements de 
memoire represente la probabilite pour qu'une cellule particuliere, reperee par 
son site <|> et sa distance d par rapport au vehicule, renferme un obstacle. 

La figure 4 represente 2 radars 11 et 12 ayant chacun detecte un obstacle, le 
premier a la distance d-j et le second a la distance d2- Par convention, on 
decide que la probabilite d'occupation d'une cellule par un obstacle est 
comprise entre -1 (la cellule est certainement non occupee) et +1 (la cellule est 
certainement occupee), la probabilite p = 0 correspondant a I'incertitude. 

Connaissant la position du foyer de chaque antenne ainsi que son axe de 
visee, on affecte a chaque cellule une probabilite d'occupation fonction de la 
distance a laquelle un obstacle a ete detecte, de la distance de cette cellule au 
foyer de I'antenne et de I'ecart angulaire entre I'axe de visee de I'antenne et la 
direction de la cellule. A litre d'exemple, la figure 5 represente la fonction de 
repartition des probabilites d'occupation d'une cellule en fonction de sa 
distance au foyer de I'antenne du radar 11, et la figure 6 la fonction de 
repartition des probabilites en fonction de I'ecart angulaire a entre I'axe de 
cetfe antenne et la direction consideree. La probabilite maximale est bien 
entendu rencontree pour la distance d-j et dans la direction de vise de 
I'antenne. 

Les differentes zones de probabilites sont portees sur les figures 4 a 6. La 
zone B de probabilite positive sur la figure 5 correspond a deux bandes 
annulaires de part et d'autre du cercle de rayon di . On verifie par ailleurs sur 
la figure 5 que seul le premier obstacle rencontre est pris en compte puisqu'au- 
dela d'une certaine distance (zone D) fonction de d 1 aucune information n'est 
apportee par la mesure. De meme sur la figure 6, aucune information n'est 
apportee par la mesure en dehors du lobe d'emission (zone A). 
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Les niveaux possibles de quantification entre les valeurs -1 et +1 dependent 
des performances du materiel de calcul utilise, la performance globale de la 
representation de I'environnement etant d'autant meilleure que ces niveaux 
sont plus nombreux. 

Lorsque Ton a de cette maniere affecte a une cellule donnee, par la mesure 
effectuee a I'aide du radar 11, une probability p1 d'occupation de cette cellule 
par un obstacle et, par la mesure effectuee a I'aide du radar 12, une probability 
p2, on met en oeuvre Falgorithme de fusion suivant : 

- si p1 > 0 et p2 > 0. 

F(p1,p2) = p1 + P 2-p1.p2 

- si p1 < 0 et p2 > 0 

F(p1,p2) = p1 +p2 + p1.p2 

- si p1 < 0 et p2 < 0 

p1 + p2 

F(p1,p2) = 

1 -Min (p1.p2) 

Cet algorithme peut etre mis en oeuvre de la fagon decrite ci-dessus, c f est-a- 
dire spacialement, en fusionnant les informations de probability provenant de 
deux radars, ou encore de maniere temporelle, en utilisant Tinformation de 
probability provenant d'un seul radar et en la fusionnant avec la probability 
deja presente pour la cellule consideree dans la memoire 8. 

Les probabilites d'occupation de I'espace s*expriment continument entre -1 
(cellule certainement vide) et +1 (cellule certainement occupee). On realise 
ensuite un seuillage des resultats de la fusion brute de maniere a obtenir une 
carte de I'environnement du vehicule sur laquelle sont portes les obstacles. 
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On peut d'ailleurs ameliorer la representation de cette carte en lui faisant subir 
une operation morphologique de type "fermeture" (dilatation - erosion), connue 
dans le domaine du traitement d'image. 

5 La carte ainsi obtenue fournit ainsi une information precise sur I'environnement 
du vehicule et permet : 

- son evolution avec evitement eventuel d'obstacles ; 

10 - sa relocalisation par comparison entre les emplacements mesures des 
obstacles et une connaissance a priori de ces obstacles. 

On peut par ailleurs envisager d'autres systemes emetteurs-recepteurs de 
signaux que le radar, par exemple de telemetres laser ou infrarouge ou des 
15 sonars. 
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REVENDICATIONS 

1. Procede de detection et de localisation d'obstacles dans Penvironnement 
tfun vehicule, caracterise par le fait qu'il comprend les etapes consistant a 
emettre des signaux en direction dudit environnement a partir d'une pfuralite de 
radars (2) disposes sur le vehicule, a deduire des signaux regajs en echo les 
probabilites ^occupation par un obstacle d'un ensemble de cellules 
elementaires (9) dudit environnement, et a fusionner les probabilites relatives a 
chacune desdites cellules. 

2 Procede selon la revendication 1, dans lequel la fusion est effectuee sur les 
valeurs des probabilites fournies par une plurality de radars, et notamment 
deux radars. 

3. Procede selon I'une quelconque des revendications 1 et 2, dans lequel la 
fusion est effectuee sur la valeur de la probability fournie par un radar et la 
valeur de la probability anterieurement connue par la meme cellule. 

4. Procede selon Tune quelconque des revendications 1 a 3, dans lequel on 
deduit, des signaux re<?us en echo, une information de distance et une 
information angulaire sur les obstacles, et on determine lesdites probabilites 
d'occupation a partir de ces informations. 

5. Procede selon Tune quelconque des revendications 1 a 4, comprenant une 
etape de seuillage des resultats de la fusion. 

6. Procede selon Tune quelconque des revendications 1 a 5, dans lequel le 
signal emis par les radars est module en frequence, le signal re^u en echo est 
melange a une fraction du signal emis pour, apres elimination de la frequence 
porteuse, former un signal de battement, et la distance d'un obstacle est 
obtenue soit par transformation de Fourrier soit par comptage pendant un 
intervalle de temps predetermine. 

7. Procede selon Tune quelconque des revendications 1 a 6, dans lequel 
remission de chaque radar dure un temps limite, et la logique de repetition est 
codee en vue de Tidentification de la source. 
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8. Dispositif pour la detection et la localisation d'obstacles dans 
I'environnement d'un vehicule, caracterise par le fait qu'il comprend une 
pluralite de radars (2) montes sur le vehicule et une unite de traitement (7) 
agencee pour fusionner les donnees fournies par les radars. 



9. Dispositif selon la revendication 8, dans lequel les radars sont a lobe large. 



2709834 




2709834 




-J 



BNSDOCID: <FR 2709834A1J_> 



2709834 

I* 1 1* 




FI6.6 



BNSDOCID: <FR 2709834A1_I_> 



REPUBLIQUE FRAN^AISE 



INS I I I li I NATIONAL 
dc la 

PROPKI KTK I N DOS I Kl LI J >* 



RAPPORT DE RECHERCHE 

PRELIM IN AIRE 

ctabli sur la base des dernicrcs revendications 
deposecs avant Ic commencement de la recherche 



2709834 

N° € enregistrement 
national 

FA 492151 
FR 9310777 



DOCUMENTS CONSIDERES COMME PERTINENTS 



Categoric 



Citation du document avec indication, en cas de besom, 
des parties pertinent cs 



Revendi cations 
cooceroees 



de la demande 
ex an i nee 



WO-A-89 06808 (PAOLETTI PAOLO) 27 Juillet 
1989 

* le document en entier * 

IEC0N 91, INTERNATIONAL CONFERENCE ON 

INDUSTRIAL ELECTRONICS, 

vol.2, 28 Octobre 1991, KOBE, JAPAN 

pages 1133 - 1137, XP313420 

PUENTE ET AL. 'Analysis of Data Fusion 

Methods in Certainty Grids Application to 

Collision Danger Monitoring' 

* page 1133 * 

ARTIFICIAL INTELLIGENCE IN REAL-TIME 
CONTROL. PROCEEDINGS0F THE IFAC WORKSHOP, 
19 Septembre 1989, SHENYANG, CHINA 
pages 19 - 24 

C.J. HARRIS 'distributed estimation, 
inferencing and multi-sensor data fusion 
for real time supervisory control' 



1,3,4,8, 
9 

6,7 

1,3,4,8, 
9 



DOMAINES TECHNIQUES 
RF.CHEROIKS (Int-CI.S) 



G01S 



I de la KckcrcBc 



18 Mai 1994 



Zacca, F 



CA TKGORJK DKS DOCUMENTS CITES 

X : partial I terement pertinent a lui seul 

Y : partiailierenent pertinent en combinaisoo avec un 

autre document de U roeme categoric 
A : pertinent a rencontre d"au mewns use revcnd i cat too 

ou arriere-ptan technotofcique general 
O : divulgation non-ecrite 
P : document intercaJaire 



theone ou principe a la base dc rinvenrion 
document de brevet beaefkiast d'nnc date anterieure 
a la date de depot et eui a' a etc public «y a cette date 
de depot oo eu'a one date postertenre. 
: cite dans la demand e 
cite poor d'autres raisons 



A : membre de la meme famille, document correspoodant 



BNSOOCID: <FR 2709834A1 I > 



This Page BlogjlftMP* 0 ) 



f 



